#include "debug.h"
void uart_print()
{

    // Serial.println(String(X_Roll.FinalAngle) + "\r");
    // Serial.println(String(Y_Pitch.FinalAngle) + "\r");
    Serial.println(String(Z_Yaw.FinalAngle) + "\r");
}